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Construction of Synergistic Potential Functions on 
SO(3) with Application to Velocity-Free Hybrid 

Attitude Stabilization 

Soulaimane Berkane and Abdelhamid Tayebi 


Abstract —We propose a systematic and comprehensive proce¬ 
dure for the construction of synergistic potential functions, which 
are instrumental in hybrid control design on 50(3). A new map 
via angular warping on 50(3) is introduced for the construction 
of such a family of potential functions allowing an explicit 
determination of the critical points and the synergistic gap. Some 
optimization results on the synergistic gap are also provided. The 
proposed synergistic potential functions are used for the design of 
a global velocity-free hybrid attitude stabilization scheme relying 
solely on inertial vector measurements. Comparative simulation 
results between the proposed global hybrid control scheme and 
the almost global smooth control scheme have been carried out. 

I. Introduction 

The attitude control problem of rigid body systems has 
been widely treated in the literature with many applications 
related to aerospace and marine engineering (see, for instance, 
D), El, 0 and J4]). The major challenge of this control 
problem is related to the motion space 50(3) where the 
angular velocity is not a straightforward derivative of the 
angular position. In fact, it was shown in 0 that, due to the 
inherent topology of the compact manifold 50(3), there is no 
continuous time -invariant feedback that globally stabilizes the 
rigid body attitude to a desired reference. The best results that 
one can achieve on 50(3), or any Lie group diffeomorphic 
to 50(3) x R 3 , with time-invariant smooth feedback laws are 
almost global, where the attitude is stabilized from any initial 
attitude except from a set of Lebesgue measure zero (see, 
for instance, 0, El, f8l). Most attitude control systems are 
obtained using the popular modified-trace function V A (R) = 
tr(A(/ —f?)), where tr (A)I—A is symmetric positive definite, 
in the Lyapunov design and analysis. For instance, consider 
the attitude kinematics R = Hil. then the angular velocity 
tensor SI £ so(3) can not be designed to globally stabilize the 
attitude R £ 50(3), at any given reference, if it is restricted 
to be smooth. Nevertheless, under the continuous feedback 

SI = —R t W a (R) = -(AR - R t A), 

one can show that the closed loop system has multiple 
equilibria corresponding to the critical points of V A where 
the gradient V V A (R) is zero. The undesired critical points 

This work was supported by the National Sciences and Engineering 
Research Council of Canada (NSERC). 

The authors are with the Department of Electrical and Computer En¬ 
gineering, University of Western Ontario, London, Ontario, Canada. The 
second author is also with the Department of Electrical Engineering, Lake- 
head University, Thunder Bay, Ontario, Canada. sberkane@uwo.ca, 
tayebi@ieee.org 


are identified by 1Z a (it,£(A)) which represents the set of all 
rotations of angle n and axis v £ 5(A), with £{A) being the 
set of unit eigenvectors of A. It is also shown that the manifold 
Tvl a (7r,§ 2 ) of all rotations of angle n is invariant under this 
feedback 0 . The appearance of undesired critical points when 
considering smooth controls on 50(3) is non-avoidable. This 
is mainly due to the fact that, according to Morse theory ED, 
any smooth potential function on 50(3) is guaranteed to have 
at least four critical points where its gradient vanishes. 

On the other hand, there have been some attempts to 
design attitude control systems with global stability results by 
introducing discontinuities. For instance, using a discontinuous 
quaternion-based control, as done in DU, one can achieve 
global stability results. However, these discontinuous attitude 
control systems, in addition to the quaternion ambiguity, 
suffer from non-robustness to arbitrary small measurement 
disturbances as explained in D2- 

The recent work in D3 focuses on the design of hybrid 
feedback systems that are able to overcome the topological 
obstruction to global asymptotic stability on 50(3) while, 
in the same time, ensuring some robustness to measurement 
noise. The hybrid algorithm is based on a family of potential 
functions and a hysteresis-based switching mechanism to avoid 
the undesired critical points. After each switching, the control 
law derived from the minimal potential function is selected. 
A sufficient condition for global asymptotic stability of the 
resulting hybrid controller is the “synergism” property of this 
family of potential functions. A family of potential functions 
on 50(3) is synergistic if at each critical point (other than the 
desired one) of a potential function in the family, there exists 
another potential function in the family that has a lower value. 
Moreover, if all the potential functions in the family share the 
identity element Ax 3 as a critical point then it is called a 
centrally synergistic family. Thanks to the hysteresis gap, this 
controller guarantees robustness to small measurements noise. 

As a consequence of this approach, the design of hybrid 
controllers on 50(3), leading to robust and global asymptotic 
stability results, boils down to the search for a suitable 
synergistic family of potential functions. The work in fH 
suggests the technique of “angular warping” to construct 
synergistic potential functions on 50(3), although without 
rigorous proof of synergism. In Da, the authors proved that 
this technique could generate a synergistic family, under some 
conditions, when applied to the modified trace function. The 
major drawback of these approaches is related to the difficulty 
of determining the synergistic gap which is required for the 
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implementation of the hybrid controller. In an attempt to solve 
this problem, the authors in na tried to relax the centrality as¬ 
sumption by considering scaled, biased and translated modified 
trace functions. However, the sufficient synergism conditions 
provided therein were very conservative, difficult to satisfy 
and only hand tuning of the parameters was proposed. Another 
form of non-central synergistic potential functions appeared in 
ED by comparing the actual and desired directions, leading 
to a simple expression of the synergistic gap. 

In this paper, we consider a central family of potential func¬ 
tions obtained via angular warping on 50(3) and derive nec¬ 
essary and sufficient conditions guaranteeing that the family 
under consideration is synergistic. We propose a new warping 
angle function that allows explicit calculation of the critical 
points as well as the synergistic gap. We also provide sufficient 
conditions on the angular warping direction to maximize the 
synergistic gap. The fact that our approach generates a central 
synergistic family is advantageous. In fact, each control law, 
derived from each smooth potential function in the central 
family, guarantees (independently) almost global asymptotic 
stabilization of the attitude. This is desirable in practice since 
the control objective remains achievable even when the hybrid 
switching mechanism runs into error. Moreover, the control 
law derived from the presented central synergistic family is 
directly expressed in terms of an arbitrary number of vector 
measurements and only two potential functions are sufficient 
to guarantee synergism. It is also worth pointing out that our 
approach to the construction of synergistic families on 50(3) 
can be adapted to other compact manifolds such as S 1 and 
§ 2 where angular warping technique has been used (TT), ITSI . 

ED. 

The second contribution consists in the design of a hybrid 
velocity-free attitude stabilization scheme relying solely on 
inertial vector measurements. The proposed synergistic poten¬ 
tial functions were instrumental in the design of such a hybrid 
controller leading to global asymptotic stability results. The 
proposed control scheme is inspired from our earlier work 
(20:1 where almost global asymptotic stability results have 
been obtained. Note that in 0 a hybrid velocity-free attitude 
controller, inspired by 0, has been proposed assuming that 
the attitude is available for feedback. Since there is no sensor 
that provides directly a measurement of the attitude, an attitude 
estimation algorithm, which usually relies on angular velocity 
measurements, is required. 

II. Attitude reprentation and Mathematical 
Preliminaries 

A. Notations and mathematical preliminaries 

The sets of real, non-negative real and natural numbers are 
denoted as R, R + and N, respectively. R" denotes the 71- 
dimensional Euclidean space and S” denotes the unit //-sphere 
embedded in R n+1 . Given two matrices A,B £ R mxn , their 
Euclidean inner product is defined as (( A,B)) = tr (A T B) 
where (-) T denotes the transpose of (•). The 2-norm of a 
vector x £ R n is ||a:|| = Vx T x and the Frobenius norm of a 
matrix A € R nxm is \\A\\ F = y/((A,A)). For a given square 
matrix A £ R nx ", we denote by A) 4 , A^ lin and A(^ ax the i-th. 


minimum and maximum eigenvalue of A , respectively. 

Given a manifold M, a tangent vector at x £ M is 7 , ( 0 ) := 
djir)/dr\ T - 0 for some smooth path 7 : R —> M such that 
7 ( 0 ) = x. The tangent space to M at x is the set of all tangent 
vectors at x, denoted T X M. The disjoint union of all tangent 
spaces forms the tangent bundle TM. Let M and N be two 
smooth manifolds and let / : M —> N be a differentiable map. 
The tangent map (differential) of / at a point x £ M is the 
map (211 

df(x) : T X M -> T f{x) N 

£ 1 -). df[x) •£:=(/ 07 )' ( 0 ), 

where 7 ( 7 -) is a path in M such that 7 ( 0 ) = x and 7 , ( 0 ) = 
£. The inverse image of a subset Sn Q N under the map 
/ is the subset of M defined by J~ 1 {Sn) = {x £ M \ 
f(x) £ 5a/}. Let / : M —► R be a differentiable real-valued 
function. A point x £ M is called a critical /wzVz/Qof / if the 
differential map (If (x) ■ £ is zero at x for all £ £ T X M. We 
denote by f C M the set of all critical points of / on M. 
Let ( , ) x • T X M x T X M —► R be a Riemannian metric on 
M. The gradient of /, denoted V/(a;) £ T X M , relative to the 
Riemannian metric ( , ) a . is uniquely defined by 

df(x) ■ i = (Vf(x),£) x for all £ £ T X M. (1) 


B. Attitude representation and kinematics 

Consider the general linear group GL(3) which represents 
the set of 3 x 3 invertible matrices, together with the ordinary 
matrix multiplication. A square matrix R £ GL(3) is called a 
rotation matrix if R belongs to the special orthogonal group 
50(3) C GL( 3) where 50(3) := [R £ R 3 x 3 |det(f?) = 
1, RR t = I}, and I is the three-dimensional identity ma¬ 
trix. The Lie algebra of 50(3), denoted by so(3), is the 
vector space of 3-by-3 skew-symmetric matrices so (3) = 
{52 £ R 3x3 I 52 T = —52} . The group 50(3) has a compact 
manifold structure where its tangent spaces are identified by 
Tr50(3) := {Rfl | 52 £ so(3)} . The Euclidean inner product 
on R 3x3 , when restricted to the Lie-algebra of skew symmet¬ 
ric matrices, defines the following left-invariant Riemannian 
metric on 50(3) 

(i?52 1 ,i?52 2 ) fl :=((52 1 ,52 2 )), (2) 


for all R £ 50(3) and 52 1; 52 2 £ so(3). Let x denotes the 
vector cross-product on R 3 and define the map [ . ] x : R 3 — > 
so(3); wu [w] x such that [uz] x tz = to x u, for all u,u £ R 3 , 
where for any vector to £ R 3 , we have 


Mx 


0 

-w 3 

w 2 

w 3 

0 

-Wi 

—w 2 

W1 

0 


If a = [ai,a 2) a 3 ] T and b = [/3i, /3 2 ,/? 3 ] T are vectors in R 3 , 
represented in some orthonormal basis B = fz.’ i, 77 , 7 / 3 }, then 
their cross product can be written as |[23l 


tt X b — } ( 

m,n,l 


(3) 


’For a reference, see Morse Theory 279 (VII.16), page 1049 of (22;j. 
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where s mn i is the Levi-Cevita symbol defined by 


C. Hybrid Systems Framework 


^mnl 


0 for m = n,m = l or n = l 

+1 for (m, n, l) G {(1,2,3), (2, 3,1), (3,1, 2)} 

-1 for (m, n, l ) G {(1,3,2), (3, 2,1), (2,1,3)} . 


Let vex : so(3) —>■ R 3 denotes the inverse isomorphism of 
the map [ . ] x , such that vex([w] x ) = to, for all uGl 3 and 
[vex(fl)] x = 12, for all 12 G so(3). By defining P a : R 3x3 —> 
so (3) as the projection map on the Lie algebra so(3) such that 
P a (A) := {A — A T )/2, one can extend the definition of vex 
to R 3x3 by taking the composition map ip := vex o P a such 
that, for a 3-by-3 matrix A := [a»j]i j= 1 , 2 , 3 > one has 


ip(A) := vex(P Q (A)) = * 


032 — 023 
Ol3 — 031 
021 ~ Oi2 


(4) 


The following identity is used throughout this paper: 

((AMx)) = 2?/>(4) T it, (5) 

where A G R 3x3 and u G R 3 . Alternatively, an element R G 
50(3) can be represented as a rotation of angle 9 G R around 
a unit vector axis u G § 2 . This is commonly known as the 
angle-axis parametrization of 50(3) and it is given by the 
map R a : R x S 2 -> 50(3): 


TZ a (6,u) :=e e[ “ Ix = 1 + sin(0)[w] x + (1 -cos(0))[u] 2 , ( 6 ) 

where e A denotes the matrix exponential of A. Equation (Jhj is 
known as Rodriguez formula. In addition, the map lZ a satisfies 
the following property 


ft o (0i, u)K a {6 2 , u) = ft a (0i+0 2 ,«), Vfli.02 G R, Mu G S 2 . 

(7) 

In this work, we may also use the unit quaternion representa- 
tio flof a rotation matrix R G 50(3). A unit quaternion Q = 
(77, e) G Q, consists of a scalar part 77 and three-dimensional 
vector e, such that Q := {Q = (■77, e) G R 4 | ?7 2 + e T e = 1 }. 
The relation between the quaternion representation and the 
angle-axis representation is given by 77 = cos (0/2) and 
e = sin (0/2) u. Therefore, a unit quaternion represents a 
rotation matrix through the map 7 Zq : Q —> 50(3) defined as 

Kq(Q) =7 + 2[e] 2 + 277[e] x . (8) 


The set Q forms a group with the quaternion product, denoted 
by ©, being the group operation and quaternion inverse defined 
by Q -1 = ( 77 ,—e) as well as the identity-quaternion Q = 
(1, 03 X i), where 03 X i G R 3 is a column vector of zeros. Given 
Qi,Q 2 G Q where Q 1 = ( 771 , 61 ) and Q 2 = ( 772 , 62 ) the 
quaternion product is defined by 

Qi © Q 2 = (771 ?72 - ej 62,0162 +77261 + [ei] x e 2 ) , (9) 

and satisfying 

K q {Q 1 )'R q {Q 2 ) = '11q(Q 1 ®Q 2 ). (10) 


z For more details on the unit-quaternion (in addition to other forms of 
attitude representation) the reader is referred to EH (m, and ED 


In this paper, we make use of the recent framework for 
dynamical hybrid systems found in (27], |28l . A subset E C 
R>o x N is a hybrid time domain , if it is a union of finitely 
or infinitely many intervals of the form [tj,tj+ 1 ] x {/} where 
0 = to < t\ < t 2 < with the last interval being possibly 
of the form [tj,tj+ 1 ] x {/} or [tj, 00 ) x {j}. Let denote 
a set-valued mapping. A general model of a hybrid system 'H 
takes the form: 

f iGf(i), xeC 
H \x + gG( x), x&D (11) 

where the flow map , F : R ra =1 R" governs continuous flow of 
x G R ra , the flow set C C R" dictates where the continuous 
flow could occur. The jump map, G : R n =1 R ra , governs 
discrete jumps of the state x, and the jump set D C R" defines 
where the discrete jumps are permitted. Note that the state 
x G R" could possibly include both continuous and discrete 
components. A hybrid arc is a function x : dom x —» R n , 

where dom x is a hybrid time domain and, for each fixed j, 

1 1 —x x{t,j) is a locally absolutely continuous function on the 
interval Ij = {f : (t.j) G dom a;}. 


III. Synergistic families of potential functions on 

50(3) 

Given a finite index set Q C N, we let C 1 (50(3) x Q, R + ) 
denote the set of positive-valued continuously differentiable 
functions U : 50(3) xQ-> R + , that is to say, for each q G Q, 
the map R 1 —> U (R. q) is continuous and differentiable on 
50(3). Additionally, for all ( R , q) G 50(3) x Q, VU(R, q) G 
Tr 50(3) denotes the gradient of U, with respect to R, 
relative to the Riemannian metric ([2]). Let 'I© C 50(3) x Q 
denote the set of critical points of U where its gradient 
vanishes '\7U{R,q) = 0. A function U G C 1 (50(3) x Q,R + ) 
is said to be a potential function with respect to the set 
A C 50(3) x Q if U(R,q) > 0 for all {R,q) <£ A, and 
U(R,q) = 0, for all ( R,q ) G A. The set of all potential 
functions on 50(3) x Q with respect to A is denoted as V(A), 
where a function U(R,q) G V(A) can be seen as a family of 
potential functions on 50(3) encoded into a single function 
indexed by the variable q. 

Definition 1. / [ 75 V For a given finite index set QcN, we let 
A = {/} x Q and IA G V{A). The potential function IA is said 
to be centrally synergistic if and only if there exist a constant 
<5 > 0 such that 


8 := min 


U ( R , q) — min U ( R , p) 
p£Q 


>S, 


( 12 ) 


where defines the set of all critical points oflA. The scalar 
8 is referred to as the synergistic gap oflA. 


The adjective “centrally” refers to the fact that all the 
potential functions R 1 —> U{ R. q) share the identity element 
I as a critical point (non-centrally synergistic families were 
also proposed in m, GD- We may drop the adjective where 
not needed. Condition ([12) implies that at any given undesired 
critical point ( R,q ) of IA G V{A) there exists another point 
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(R,p) £ 50(3) x Q such that U(R,p) has a lower value than 
U(R,q). In the remainder of this paper, we let 

A := {/} x Q. 

It the recent literature, it was shown that once a synergistic 
family of potential functions on 50(3) is obtained, a hybrid 
feedback controller that achieves global asymptotic stability 
results immediately follows a, m, urn m- The idea in 
0 consists of stretching and compressing 50(3) by applying 
the following transformation on 50(3) x Q 

T(R, q) = 7 Z a (k q P(R), u)R , (13) 

where it £ § 2 is a constant unit vector, k q £ R is an indexed 
scalar gain, P is a smooth positive definite function on 50(3) 
with respect to 7. By composing the map T with an existing 
potential function, one can relocate the critical points while 
leaving the identity element a fixed point for all q £ Q. 
Despite the originality of this approach, it was abandoned 
mainly due to the difficulty in finding an explicit expression 
of the synergistic gap. 

In this section, we build up from the ideas in 0 towards more 
generic constructions of central synergistic potential functions 
on 50(3) via “angular warping”, while providing a thorough 
analysis of the synergism properties. Let u £ § 2 be a fixed 
unit vector. Let us consider the map T : 50(3) xQ-) 50(3) 
such that 

r (R,q):=KRa(O q (R),u), (14) 

where 9 q : 50(3) -)■ R is a real-valued function which is 
injective with respect to the index q. Note that the map in 
© uses a left multiplication of R by the additional rotation 
7 Z a {kqP(R),u). In this work, however, we chose a right 
multiplication of R by lZ a (9 q (R),u) where the map 9 q is 
to be designed later. This choice will allow us to express the 
control input directly in terms of vector measurements as done 
in Section HVl 

Lemma 1. Let u £ S 2 and Q C N. If the map 9 q (R) : 
50(3) —> R is differentiable then the following properties 
hold: 

1) The time derivative ofT(R,q) along the trajectories of 
R = 7?[w] x is given by 

jT(R,q)=T(R,q)[Q(R,q)u } \ x , (15) 

where 0(7?, q) = R a (9 q (R),u) T + 2u4’(R T \7 9 q {R)) r . 

2) If det(0(7?, q)) ± 0 for all ( R,q ) £ 50(3) x Q, 
then the map R H > T(R,q) is everywhere a local 
dijfeomorphism. Moreover, if V : 50(3) —> R + is a 
smooth positive definite function on 50(3) with respect 
to I and r -1 ({/}) = {7} x Q then U = V o T £ P(A) 
with A = {7} x Q and the set of critical points oflA is 
given by = r _1 (T'y). 

Lemma |T| shows that, under some conditions on the trans¬ 
formation T, one can construct a new family of potential 
functions on 50(3) by considering the composition of a basic 
potential function on 50(3) and the map T. In particular, it 
would be interesting to consider the modified trace function 


Va(R) = tr(A(7 — 7?)) as the basic potential function due to 
its nice properties. The following technical lemma gives some 
of the useful properties of the potential function Va- 

Lemma 2. Let A = A r and Va{R) = ti(A(I — 7?)), such 
that W := tr(A)7 — A is symmetric positive definite. Let 
{th; *’ 3 } be an orthonormal eigenbasis, where Vi is a unit 
eigenvector associated to the eigenvalue Xf. Then, for all 
R £ 50(3), the following properties hold: 

VVa(R) = RPa(AR) £ T R SO( 3), (16) 

*Va ={I}UTl a (Tr,£(A)), (17) 

where £(A) denotes the set of (real) unit eigenvectors of A. 
Moreover, for all (0, u) £ R x S 2 , one has 

V A (n a (9,u)) =2sm 2 (9/2)u T Wu, (18) 

Va (Ka( 7T, v)7la(9, u)) = 2 A w -2 sin 2 (9/2)A(v, u), (19) 

where A M denotes the eigenvalue of W associated to the 
eigenvector v £ £(W) = £(A) and A (v,u) is computed as 
follows. 

1) If A = XI 3 (A,f = A, * = 1,2,3), then £(A) = S 2 and 

A(v, u) = A w cos 2 (4>), c/) = Z(u,v) 

2) If A has two distinct eigenvalues Aj 4 = A;f 7 ^ A 3 , then 
£{A) = {*'i 2 , ^ 3 }, *'12 £ span{*'i, *; 2 } D S 2 , and 

A(**i 2 ,**) = (1 - (u T v 3 ) 2 )[A^ - A^ sin 2 (^)], 
A(u 3 ,*x) = (A^ - A^(l - (u t v 3 ) 2 )) , 

such that (f> = Z(*'i2,*t _L ) and u L is the projection of u 
on the plane spanjui, vfj- 

3) If A has three distinct eigenvalues 0 < A q < < Ajf, 

then £(A) = {*'i, f 2 5 ^ 3 } an d 

A(vi ,**) = - {u T v 2 ) 2 XY - {u t v 3 ) 2 XY, 

A(v 2 ,u) = A^ - (u r v 3 ) 2 XY - (** T *h) 2 Ar, 

A (v 3 ,u) = XY - (u T vi) 2 XY - (v T v 2 ) 2 XY■ 

In (H, using the transformation T defined in m the 
authors derived sufficient and necessary conditions such that 
the potential function Va ° I is synergistic in the case where A 
has distinct eigenvalues. In the following theorem we provide 
sufficient and necessary conditions, using our transformation 
T defined in such that the potential function Va oT is 
synergistic for an arbitrary spectrum of A and a general angle 
function 9 q f). 

Theorem 1. Let A = A T such that tr(/l) / — A is a symmetric 
positive definite matrix. Let Q C N be an index set of finite 
cardinality greater than or equal to 2. Consider the transfor¬ 
mation T defined in © and assume that det(0(7?, q)) 7 ^ 0 
for all (R,q) £ 50(3) x Q and L” 1 ^}) = {7} x Q. The 
potential function 

U(R , q) := V a (T(R, q)) = tr (A(I - T(R, q))), 
is synergistic if and only if 

A(v, *t) > 0, for all v £ £(A), (20) 

where A (*',**) is given in Lemma [ 2 ] 
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Theorem [T] provides necessary and sufficient conditions of 
synergism for the family of perturbed modified trace functions 
VA(T(R,q)). The condition A (v,u) > 0, Vv £ 5(A), 
imposes a constraint on the choice of the direction u of the 
angular warping and the spectrum of the weighting matrix 
A. The following proposition discusses the feasibility of the 
synergy conditions of Theorem |T| 

Proposition 1. Let A = A T such that \ r(A)I A is a symmet¬ 
ric positive definite matrix. Let pa = (Aj 4 + (— lfiX^)/(X^ + 
A^). Then, the synergy condition \20\ is 

• not satisfied if A = A /3 (A, = A, i = 1,2,3) for all 
u £ § 2 . 

• satisfied if A has two identical eigenvalues 0 < A } 1 = 
X 2 < X 3 and 

0 < P 33 < 0 T tAs) 2 < 1- 

• satisfied if A has distinct eigenvalues 0 < A ) 1 < A ^ 1 < A $ 
and 


— Q33(u T Vi) 2 + Q23 < {u T V2) 2 < — f?32(w T tfi) 2 + £>22, 

where Vi is the unit eigenvector of A corresponding to the 
eigenvalue A' 4 . 

Proposition [I] suggests that a necessary condition for syner¬ 
gism of V a (T(R, q)) is that the weighting matrix A must have 
at least two distinct eigenvalues. Furthermore, the direction 
u of the angular warping should be carefully chosen with 
respect to the eigenvectors of A in order for the potential 
function Va{T(R, q)) to be synergistic. Later in Proposition 
[5] we will provide an optimal choice of the unit vector u £ § 2 
that satisfies the feasibility conditions of Proposition |T| while 
maximizing the synergistic gap. 

When the synergism condition ( |20| ) is verified, it is im¬ 
portant to explicitly compute the value of the synergistic 
gap required for the implementation of a synergistic hybrid 
controller. To do so, one needs to calculate the undesired 
critical points of Va(T(/?, q)) to evaluate the expression of the 
synergistic gap in ( | 1 2\ . These undesired critical points are ob¬ 
tained by solving equation ( |46| ) for the unknown R £ SO( 3). 
Equation ( |46| , along with the result of Lemma [2] yields 

V a (R) = 2 X w -2sin 2 (6 q (R)/2) A(v,u), ( R,q ) € 

( 21 ) 

In 0, the warping angle was chosen as 9 q (R) = k q VA{R), 
thus the above equation leads to the following nonlinear 
algebraic equation for the unknown Va{R), 

V a {R) = 2X W - 2 sin 2 {k q V A {R)/2) A(v, u). 


The above equation can be solved numerically but an explicit 
solution is hard to obtain. Instead, we propose the following 
choice of the warping angle 9 q : SO( 3) —> (— 


d q {R) = 2 arcsin (, k q V A {R )), k q £ 0, (22) 

that leads, in view of ( | 2 T| l, to a quadratic equation in Va(R) 
which can be solved to obtain 


V a (R) 


— 1 + yjl + 16X W k q A(u, v ) 
4k q A(u, v) 


(■ R,q ) e A 

(23) 


Once the value of Va{R) is obtained at the undesired critical 
points of U = Va (V(R. q)), one can compute these undesired 
rotations as follows 


R = Uaitt, v)TZ a ( 6 q (R), u) T , 

0 q (R) = 2 arcsin (k q V A (R )), (R, q)&*u\ A. (24) 


Note that the scalar gain k q needs to be selected to ensure that 
0 q {-) is well defined for all R £ SO (3). Also, one must make 
sure that the conditions of Lemma |T| are verified to guarantee 
that V A (T(R,q)) is a suitable potential function on 50(3) x 
Q with respect to {/} x Q. This is the purpose of the next 
proposition. 


Lemma 3. Let u £ S 2 be a unit vector and A = A T such 
that W = tr(A)/ — A is a symmetric positive definite matrix. 
Consider the transformation T as defined in where 9 q f) 
is given by \22\. If the scalar gain k q satisfies the inequality 


| k q | < k 


1 

2 ASax \/6- max{ 1,4£ 2 } ? 


(25) 


where £ = Aj^ in /A^ ax . Then r -1 ({/}) = {/} x Q and 
det(0(/?, q)) 0, for all R £ 50(3) and q £ Q. 

Furthermore, the gradient of the angle warping function 0 q 
is given by 

X79 q (R) = 2k ^ BF ^ AR ) 


jl-k*V&R) 


(26) 


As a consequence of Lemma [3] if the scalars k q satisfies 
( |25j ) then, by Lemma [T] the composite function U = I /4 o T 
is a suitable potential function on 50(3) x Q with respect 
to A = {/} x Q. Once the set of critical points for the 
potential function U = Va (L(R. q)) is determined from ( |24| , 
the synergistic gap defined in ( fl2l ) can be evaluated. In the 
following theorem, we explicitly provide the expression of the 
synergistic gap of U in the case of Q = {1,2}. Note that, 
one of the features of the angular warping approach is that a 
synergistic family can be generated using only two potential 
functions on 50(3). 


Theorem 2. Let u £ § 2 and A = A T such that W = tr(A)/— 
A is a symmetric positive definite matrix. Let Q := {1,2} and 
let jfei = — Z 2 = k, with k satisfying condition ( |25| ). Consider 
the transformation L as defined in where 0 q f) is given 
by \22) . Assume that A (it, v) > 0 is satisfied for all v £ £(A), 
then U = Va{T(R 1 q)) is synergistic with a gap 5 given by 


5= min cr(k, X w , A(v, u)) > a(k, A, A) (27) 

ve£(A) 

such that 


a(k,X w ,A(v,u)) = 8 k 2 V 2 {l-k 2 V 2 )A(v,u) (28) 

y = -1 + y/l + l 6 X w k 2 A(v,u) 

4k 2 A(v,u) y ’ 

where X= min X n and A = min A (v.u). 
v€:£(A) v€l£(A) 

It is interesting to figure out the optimal vector u £ § 2 such 
that the synergistic gap given in ( |27j ) is maximized while the 

condition of synergism min A (v,u) > 0 is verified. Since 

v££(A) 
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<j{k,X w , A(v,u)) is a strictly increasing function of A (v,u) 
as shown in the proof of Theorem [2] we perform the following 
maximization with respect to u £ S 2 . 

max A = max min A(v, u ) ) . (30) 

wes 2 lies 2 \ve£(A) ) 

Proposition 2. The unit vector u £ S 2 , solution of the 
maximization ( |30[ ), satisfies the following: 

• if A has two distinct eigenvalues 0 < A ) 1 = X A < X A , 

(u t u 3 ) 2 = 1 - 

• if A has three distinct eigenvalues 0 < Aj 4 < A ^ 1 < A^, 


■u 


v 1 = 0 , (u v 2 ) = 


\£ 


(■ u'v 3 y = 




+ Xf 


^2 + ^3 ’ 

A > Af 1 A^/(Ay — A) 1 ). Otherwise, the optimal 
solution is 


if K 


(«' Vi) 2 = 1-4 


n 


\A 

jjti A j 


E iA \ A ’ 

i/fc A j A k 


i e {1,2,3}. 


Propositionplgives an optimal choice of the angular warping 
direction u £ S~ that maximizes the synergistic gap. Moreover, 
it is straightforward to verify that this choice of u satisfies 
the feasibility conditions of Proposition [T| Consequently, a 
complete construction of a synergistic potential function via 
angular warping with an explicit maximized synergistic gap 
has been achieved. 


IV. Hybrid velocity-free attitude stabilization 

USING VECTOR MEASUREMENTS 
We assume that the rigid body is equipped with sensors that 
provide measurements in the body-attached frame, denoted by 
bi £ R 3 of constant and known inertial vectors rq £ R 3 , i = 
1 , 2 , ...,n > 2 , satisfying the following assumption: 

Assumption 1. At least three vectors, among the n inertial 
vectors, are not collinear. 

It should be noted that this Assumption [T] is needed in our 
analysis and does not exclude the case where measurements 
of only two non-collinear inertial vectors are available, say b\ 
and l >2 corresponding to the non-collinear inertial vectors rq 
and r 2 . In this case, one can always construct a third vector 
63 = 6 i x b -2 which corresponds to the measurement of r 3 = 
rq x r 2 . The rigid body rotational dynamics are governed by 

R = R[u] x , (31) 

Jut = [Jui\ x ui + t, (32) 

where R £ SO( 3) represents the attitude, ui £ R 3 being 
the angular velocity of the rigid body expressed in the body- 
attached frame and J £ R 3x3 is the constant inertia matrix 
of the rigid body. The control torque, expressed in the body 
frame, is denoted by r £ R 3 . 

Our objective is to design a hybrid control input torque r, 
using only vector measurements, guaranteeing robust global 
asymptotic stabilization of the attitude R £ SO( 3) to a desired 


constant reference Rd £ SO( 3). 

Let us define the following auxiliary dynamic system 

h = m*, ( 33 ) 


with an arbitrary initial condition R( 0) £ ,S'0(3) and a design 
variable /? £ R 3 to be defined later. Let Xh = RY^ , 
h £ {1,2}, with Y\ = R and V 2 = //,/. The rotation 
matrix A ' 3 describes the discrepancy between the actual rigid 
body orientation and the orientation provided by the auxiliary 
system {33}, and the rotation matrix A ' 2 describes the dis¬ 
crepancy between the actual rigid body orientation and the 
desired orientation. Let Q C N be an index set of finite 
cardinality and let our state variables be A = (A” 1 ,X 2 ) £ 
V x := 50(3) x 50(3), and q = ( qi ,q 2 ) £ V q := Q x Q. 

n 

For h £ {1,2}, let us define Ah = PihTi,rJ , where 

Pih > 0 are some positive scalars . Assumption 1 ensures 
that Ah, h = 1,2, are positive definite matrices. For some 
arbitrary unit vectors Uh £ § 2 , h = 1 , 2 , and a set of arbitrary 
scalars kh q satisfying the conditions 




1 

2 A max \/6 - max{l,4£2} ’ 


h = 1,2, q £ Q, 


with £ h = A^ h n /A^ x and W h := tr (A h )I - A h , h = 1,2. 
We define the following maps T/, : 50(3) x Q —>■ 50(3) such 
that 


Fh(R,q) = RRa{ 8 hq (R),Uh), 

Ohq(R) = 2 arcsin (k hq V Ah (R)), 

V Ah (R) = ti(A h (I-R)), 

for h = 1,2. According to Section m and in view of the 
above definition of the maps Fh, h = 1 , 2 , one ensures that 


U h {R,q) := V Ah o T h (R,q), 


are both two potential functions on 50(3) x Q with respect 
to {/} x Q. We propose the following hybrid switching law 
for the control input r and the input of the auxiliary system 

{33} 


2 

T = -2 Y, Y h ®h(X h , q h ) T *P(A h T h (X h , q h )), 
P = 0i(A}, qi) T t/t(AiTi(Xi, qi )) 

q = 0 

^-- 

(x, q )ec 

T + = T 

P + =P 

q + =9(X ) 


(34) 


(X,q )GD 


where Q h (R,q) 


Ra(Shq{R), U/i) T + 


4k hq u h ip(A h R) T 


and 



( 91 , 92 ) £ Q x Q:q h 


argmin U h (X h , p ), 
peQ 

h = 1,2}, 
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and the sets C, D C T>x x are given by 


and b ih (q) = Y^ TZ a {O hq {X h ), Uh)n, for h = 1,2, f/zen 


C := {(X,g) eDxxD,: MiP^i^i) < <5i and 

P-2{X 2 , q 2 ) < ^ 2 } 


L> := {(X,g) e X>a- x V q : /zi(Ai,gi) > <5i or 

M2 (*2, 92) > ^2} 

such that H h (X h ,q h ) = U h (X h ,q h ) - min U h (X h ,p), h = 

peQ 

1,2. The hybrid controller ( [34] ) results in the closed-loop 
system 

Xi = Ai [Viw - 0i(Xi,qi) T -!/>(4 1 ri(AT, (? i))] := Xi[wi] x , 

-X *2 = X2 [Y2UJ] X := ^ 2 [w 2 ]x, 

2 

Jw = [Jw] x w - 2 ]T y h T e h (x h , %) T t/>(A h r ft (A h , qh )), 

h=1 

q = 0 


(x, q )ec 

X + = X 
oj + = u> 



(X,q)eD 


(35) 


Since Y\ = A, 1 X 2 Y 2 and Y 2 is constant, it is clear that the 
closed loop dynamics ( |35j ) are autonomous. The goal of this 
hybrid controller is to ensure global asymptotic stability of the 
set 


4 — {(A, cu, q') £ T>x x x R q : X\ — X 2 — I , oj — 0}. 

Theorem 3. Consider system (|3T)-([32j) and the auxiliary 
system © under the hybrid control law given in Assume 
that n vector measurements hi, corresponding to the inertial 
vectors 1 i = 1, - • • , n > 2 are available, and Assumption 
|7] holds. If the potential function U\, respectively IA 2 , is 
synergistic with gap exceeding 6 1 , respectively S 2 , then the set 
A is globally asymptotically stable for the closed-loop system 

(113- 

In practice, it is useful to explicitly express the control 
inputs in terms of the available vector measurements. Such 
measurements can be obtained, for instance, from an In¬ 
ertial Measurement Unit (IMU) that typically includes an 
accelerometer and a magnetometer providing, respectively, 
measurements of the gravitational field and Earth’s magnetic 
field expressed in the body frame. The following Lemma 
shows that the terms involved in our hybrid control scheme can 
be directly expressed in terms of the available inertial vector 
measurement. 

Proposition 3. The following relations hold: 


1 n 

v Ah (x h ) = - Pih ^ - Yh n 2 , 

i= 1 

(36) 

1 U 

tp (A h X h ) = -Y h ^2 Pih{bi x y fc T n), 

i =1 

(37) 

2. Furthermore, for q £ Q let 


8 h q (X h ) = 2arcsin (k hq V Ah (X h )), 



Xji,q) — _, ^ Pih bj bihiq) 


i= 1 


(38) 


1>(A h T h (X h ,q)) = -7 Z a (e hq (X h ),u h ) r Y h 


Pihffi x b ih (q)). 

(39) 


*=1 


We devote the next section to prove all the Lemmas, 
Propositions and Theorems presented throughout the paper. 


V. Proofs 


A. Proof of Lemma [7] 

Lirst, using the product mle and the fact that f?[u] x f? T = 
[Rv] x for all R £ 50(3) and v £ R 3 , it is straightforward to 
show that if R s = f? s [w s ] x , s = 1, 2, then 

j t (R 1 R 2 ) = RiR 2 [R]io 1 +co2] x . (40) 

On the other hand, using ([2| and (|5j, one has 

e q (R) = dd q (R) ■ R = {X6q{R), = 2 f{R T Vd q {R)) T uj, 

which, using the fact that = e e ^ A 6(t)A, yields 

jK a {e q (R.) ,u) = n a ( e q (R) , u)e q (r) m x 

= K a (9 q (R),u) [2u^(R T Ve q (R)) T uj] x . 

(41) 


Since T(R,q) = RTZ a (8 q (R),u) then, in view of (40) and 
(411, one obtains t(R,q) = V(R, q) [Q(R, q)uj] x where 
e\R,q) = n a (8 q (R),u) T + 2u vex(f? T V6> g (f?)) T . 

Lor some q £ Q, let us define the mapping T q (R) = 
T(R, q). The time-derivative of the map T q is nothing but the 
differential of T q in the tangent direction £ = R = i?[uz] x . 
Replacing ui = vex(f? T £) in equation (15 1 shows that 

dT q (R) ■ £ = T q (R)mR,q)vex(R T 0)x, Z € T R SO( 3). 


It is clear that when the inverse of the matrix 0(7?, g) exists 
for all R £ 50(3) the map d 

mathcalT q (R) ■ £ is an isomorphism (bijective). In fact, for 
all y := dT q (R) • £ £ Tj- q ^SO(3), the inverse is explicitly 
given by 




R 


(0(f?,g)) 1 vex (T q (R) T y) 


£ T r SO( 3). 


Consequently, the inverse function theorem j29l guarantees 
that 7 q {R) is a local diffeomorphism for all R £ 50(3). 
Lurthermore, when T is everywhere a local diffeomorphism 
on 50(3) and V : 50(3) x R + is a smooth positive definite 
function, the composite function U = V oT is a differentiable 
positive function on 50(3). If in addition T _1 ({/}) = A 
then U{R, q) = 0 if and only if (7?, q) £ A which shows that 













U G V(A). In this case, the time-derivative of U = V oT can 
be computed as follows 

U(R,q) = dV(r(R,q))-t(R, q ) 

= {VV(T(R,q)),t(R,q)) nR}q) 

= 2 il> (v(R, q) T X7V(r(R, <?)))% (r (R, q) T t(R, g)) 

= 2 i, (r (R, q) T X7V(r(R, q))Y Q(R, q)u, 

(42) 

where p} and <| 15 [ > have been used. Consequently, since the 
matrix &(R, q) is full rank, the set of critical points of U is 

= {(R,g) G SO( 3 ) x Q : f (r(f?,q) T Vl/(r(Jf,g))) = o} 

Also, the set of critical points of V(R) is given by \Ev := 
{R € 50(3) : i/j(R t 'VV(R)) = 0}. This shows that R G 
if and only if T(R 1 q) G \Ev, which proves that = 


B. Proof of Lemma [2] 

Recall from Section |II-A that the gradient X/V A (R) can 
be computed using the differential of V a (R) in an arbitrary 
tangential direction £ = RQ G T R SO( 3), such that 


DV A (R) ■ £ = {VV A (R),Rn) R = {{R T vv A (R), n». 

(43) 


On the other hand, one can compute DV A (R) ■ £ by direct 
differentiation pf V A (R) = tr (A(I — R)) as follows 


DV A (R) • £ = —tr(A£) = -tr(ARfl) = {{AR, f2)). 


Thus, one has DV A (R) ■ £ = ((P a (AR), f l}} since 0 is skew 
symmetric. Therefore, in view of ( |43j ), yields ( [T6| ). The proof 
of ([17]) is given in [0, Lemma 2], Now, let Q = (p, e) G Q 
and (0,«) G R x § 2 be the quaternion and the angle-axis 
representation of the attitude matrix R, respectively. Using the 
Rodrigues formula ([8J one obtains 

V a (R) = tr(A(- 2[e] 2 - 2J?[e] x )) = -2tr (A[e] 2 x ), 


sin 2 (</>) = 1 — cos 2 ((/>) where = Z(u,v), one can compute 
the value of V A (P v ) from equation (fi~8|) and (44 1 to obtain 


V A (P v )= 2X w e//e v 

= 2A W [cos 2 (0/2) + sin 2 (0/2) Hu x w|| 2 ] 
= 2A w -2sin 2 (0/2)A (v,u), 


where A (v,u) = X w cos 2 (</>). 

2) A has two distinct eigenvalues X 3 

Since {viU 2 ,u 3 } is an orthonormal basis, one can decompose 
R 3 = E 3 © E$, where E 3 := span{u 3 } and E^ := 
span{ui,V 2 }- Therefore, each vector v G R 3 is uniquely 
decomposed as v = tr + U 3- such that tr G E 3 and u 3- G E$. 
Consequently, W(v 3 x u) = W(v 3 x w 1 ) = A^ (u 3 x rr 1 ) 
which, in view of ( |44] l, yields 

We V3 = W (cos(0/2)u 3 + sin(0/2)(u 3 x u)) 

= cos(0/2)u 3 + A Y sin(0/2)(u 3 x u 3- ). ^ ^ 


Now, making use of (451 and the fact that v 3 (v 3 x A) = 0 
and ||v 3 x zi 3- 1| 2 = ||u T ]| 2 = af + a\, equation (18 1 yields 


V A (P V3 ) = 2 elWe V3 

= 2 \Y cos 2 (0/2) + 2Af sin 2 (0/2)(a 2 + a\) 
= 2X^ — 2sin 2 (0/2)A(u 3 ,w). 


Let v \2 G L^TiS 2 , and 4> = Z(ui 2 ,tr L ). In view of (44 1 , and 


using the fact that u = it 11 


~, the quaternion vector e v 


decomposed as e Vl2 = ej( 12 + ef 12 where 


4 12 = sin(0/2)(ui2 x it 3- ) G E 3 , 

e v 12 = cos(0/2)ui2 + sin(0/2)(ui2 x u 11 ) G E^. 


Making use of the identity ||uxu|| 2 = ||zi|| 2 ||'L’|| 2 sin 2 (</>), such 
that <j> = Z(u, v), the norms of eJJ and can be computed 
as follows 


|| e y| 2 =sin 2 (0/2)|h 2 x^|| 2 

= sin 2 ( 0 / 2 )||ui 2 || 2 ||u J -|| 2 sin 2 (^) 
= sin 2 (0/2)(ct 2 + a 2 ) sin 2 (0), 


where we used tr(A[e] x ) = ((A, [e] x )) = 0 since A is 
symmetric. Also, using [e] 2 = —1|e|| 2 7 + ee T and e T Ae = 
tr(Aee T ), one obtains 

Va(R ) = 2tr(e T eA - Aee T ) = 2e T IUe, 

which yields ( p~8| ) by noting that e = sin(0/2)u. 

Let Q v = ( rj v ,e v ) be the quaternion representation of the 
attitude P v := lZ a (n, v)lZ a (0, u) such that P v = 7 Zq{Q v ), 
for some 9 G R and u,v G § 2 . Making use of the 
quaternion multiplication rule (|9]) and ( fT(j| ), and the fact that 
lZ a {Tr,v) and lZ a (9,u) correspond to the quaternion (0,u) 
and (cos(0/2), sin(0/2)it), respectively, the quaternion vector 
part of P v is given by 

e v = cos(0/2)v + sin(0/2)(u x u). (44) 

We let on := u T i>i denotes the coordinates of u in the 
eigenbasis {«*}»£{!, 2 , 3 }- 
1) A = A I 3 

In this case, using the fact that v T (v xu) = 0 and ||t; x zt|| 2 = 


and 

IkiJI 2 = cos 2 (0/2)||-ui 2 || 2 + sin 2 ( 0 / 2 )||t;i 2 || 2 ||M ll || 2 
= l-sin 2 (0/2) (l — ct 2 ) . 

where the fact that ||ui 2 || = 1 has been used. Therefore, since 
We Vl2 = Xf 4 12 + XY 4 12 , one obtains 


Va(Pv 12 ) — 2 e Vl2 We Vl2 

= 2Ari|eLl| 2 + 2Ar||e4 2 || 2 
= 2XY - 2sin 2 (9/2) (a 2 + a|)[Af - Xf sin 2 (^)] 
= 2AJ/ — 2sin 2 (0/2) A(r)i 2 , u). 


3) A has three distinct eigenvalues 0 < Xf < X? < X 3 
Using (3 1 one has v m x u = ^^Smni&nVi, which allows to 


write 

lft„ m = W (cos(0/2)v m + sin(0/2)(u m x u)) 

= cos(0/2)A,^v m + sin(0/2) 'Y' s mn ia n XY vi, 


n,l 
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where the fact that Wv m = A Y v m for all m £ {1,2,3} has 
been used to obtain the last equality. Now, in view of ( f]~8f > and 
using the fact that v/^vi = 0 for m l, one gets 


V A (P Vm ) = 2 e// m We Vm 

= 2 cos 2 ( 0 / 2 ) + 2 sin 2 (9/2) ^ s 2 mnl a 2 n A 


w 

l 


= 2 \% -2 sin 2 ( 0 / 2 ) 




2 o 2 \ W 


= 2A^-2sin 2 (0/2)A (v m ,u). 


C. Proof of Theorem [7] 

According to Definition [I] the potential function U is 
synergistic if 


hi(R, q) — min U(R,p) > 0, 
peC 


V(R,q) £ V u \ A 


According to Lemma [2j the set of critical points for the 
function V A is x ^v A = {1} U ' 1Z a (n,v), v £ £(A). Invoking 
Lemma [T| the set of critical points for U = V A o T is given 
by 

4 'u = AU ve£{A) T~ 1 (TZ a (ir 1 v)). 

Let v £ £(A) and let (R, q) = T~ 1 (/R, a (-K ) v)). Thus, 
T(R 1 q) = TZ a (n,v), which in view of (14 1 , yields 


R = TZa(^, v)K a (9q(R), u) T . 


(46) 


Therefore, for a given p £ Q, one has 
T(R,p) = RK a (9 p (R),u) 

= ^ a ( 7 r, v)n a (9 q (R),u) T n a (d P (R),u) 

= TZ a (^,v)TZ a (/9 pq (R),uj , 

where 9 pq (R) = 9 p (R)—9 q (R) and identity (|7j» has been used. 
Consequently, invoking Lemma [2] one obtains 

U(R,p) = V A (T(R,p)) = 2X w -2sm 2 (d pq (R)/ 2 ) A (v,u). 

On the other hand, one has U(R 1 q) = V A o T(R,q) = 
V A (TZ a ('n’, v)) = 2 v t Wv = 2A 1 ' . Therefore, at any undesired 
critical point (R, q) £ 'S'u \ A, one has 

U(R,q) — min U(R,p) = 2 max sin 2 (o pq (R)/2) A (v,u). 
P&Q p&Q V / 

(47) 

Since 9 q (-) is injective with respect to q, one has p 7 ^ q 
implies that 9 pq (R) 7 ^ 0. Consequently, in view of ( |47f >, the 
necessary and sufficient condition for hi to be synergistic is 
that A (v,u) > 0 for all possible v £ £(A). 


D. Proof of Proposition |7] 

Since A is a symmetric matrix, it follows that the eigenvec¬ 
tors of A can be chosen to form an orthonormal basis of JR 3 , 
denoted {v 3 ,v 2 , W 3 }. We let a, := u T Vi define the coordinates 
of u in the eigenbasis of A. We have three possible cases: 

1) A = A / 3 (\? = A, $ = 1,2,3) 

In this case, the set of unit eigenvectors of A is £(A) = 


S 2 and according to Lemma |5j one has A (v,u) = 
A 1 ' cos 2 (</>), where <fi = Z(u,v) for all v £ £(A). 
However, for any chosen u £ S 2 there exists v £ £(A) 
such that Z(u,v) = n/2, or equivalently A (v,u) = 0. 
Therefore, the synergy condition of Theorem [I] can not 
be verified in this case. 

2) A has two distinct eigenvalues Xf = X 2 7 ^ A // 

In this case, the set of unit eigenvectors of A is £(A) = 
{V 12 , ^ 3 }, where v \ 2 € span{tq, V 2 } H S 2 . Thus, accord¬ 
ing to Lemma [2] the synergy condition of Theorem [T] is 
written as 

A(v 3 ,u) = (Af -Xf(a\ + al)) >0 
A(v 12 ,u) = (af +al)[Xf - XY sin 2 ((j>)] > 0, 

for all cj> = Z(ui 2 ,rr L ) such that u -1 represents the pro¬ 
jection of u on the plane spanjui, x; 2 }. Since sin 2 (0) < 1 
and aq+a 2 = 1 —a 2 , the above conditions are equivalent 
to 0 < XY (1 — ct 3 ) < A^ < Awhich leads to 
/ \tv\ 

0 < V W) < < L (48) 

3) A has three distinct eigenvalues 0 < Xf < X 2 < X 3 

In this case, the set of unit eigenvectors of A is £(A) = 
{ui,i> 2 , V 3 } and, according to Lemma [ 2 ] the synergy 
condition of Theorem |T] is written as 

A(v m ,u) = X^~J^£^ nl alX^ >0, Vroe {1,2,3}. 

n,l 


Using the definition of the Levi-Cevita symbol given in 
section (II-B 1 , it is straightforward to verify that A(v m , u) 


can explicitly be written as 


A(v±,u) = A} 1, — a 2 XY — a 2 A^, 
A(v 2 ,u) = X¥-a 2 X™-a 2 XY, 
A(v 3 ,u) = XY-a 2 XY-a 2 XY- 


(49) 


Since u is a unit vector it verifies the unit constraint oi = 


1 — aj — a 2 . Thus, equations (49 1 are rewritten as 


A(vi,u) = (XT~XY) + aj(XY ~ Xf) + afxY 

+ XYa 2 -(XY -XY) 


A(v 2 ,u) = (XY - xY) 


a 

A(v 3 , u) = -XYa{ - xYal + A : 


iW 


Note that, since the eigenvalues of the matrix W = 
tr (A)I — A are given by A Y = tr(A) — Xf, it is 
obvious that A Y > A Y > A Y > 0 which implies that 
A(vi,u) > 0. The conditions A(v 2 , u),A(v 3 ,u) >0 are 
equivalent to x( a i) < a 2 < x(a 2 ) where 


X(«?) 

X(«i) 


(Ar-A 3 ^)„2 , (Af-Af) 


Ai 


w 


w 


a 2 


^2 




\W 

A 3 

xY ’ 


Af 


Now, since A Y + A Y ~ A Y = 2A } 4 > 0, it is 
easy to verify that XY/X™ > (A } 1 — XY)/XY and 
A Y /A Y > (A } 1 — XY)/(X 1 / — XY). A sketch of the 
feasible region is given in Figure[l]which shows that there 
always exist af and a\ such A(v 2 ,u), A(v 3 ,u) > 0 . 
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Replacing = tr(H) — Xf in the above inequality leads [e] 2 = — ||e|| 2 / + ee , one has 
to the item 3 of Proposition [T] Finally, one can conclude 
that in the case where the matrix A has arbitrary distinct 
eigenvalues, one can always find a unit vector u £ § 2 
such that a synergistic family of potential functions (via 
angular warping) is constructed. 


P«(AR) = -(AR-R t A) 

= Aee r - ee T A + rjA[e] 
= [e x Ae] x +r)[We] x , 


+ vMxA 


2 

a 2 



■» at 


Fig. 1: The feasible region of the synergy condition (201 
in the case where A has distinct eigenvalues. 


E. Proof of Lemma [j] 


In view of (181 one has Va(R) < 2A^ ax which, in view 


using (18 1 and the fact that sin(9 q (R) /2) = k q VA(R), yields 
V a (R) = 2sin 2 {9 q (R)/2)u T Wu = 2k 2 VA{R)u T Wu, 


or equivalently (1 — 2 k 2 VA(R)u T W u)Va(R)__= 0. 


ever, since u 

u2t/. I d\„.T 


§ 2 and \k q \ satisfies d25L 

. . n , _ ti; _ o ’ . , _ * _ * 


V 0 ,(i?) = 


2 k q VV A (R) 


2k q RP a (AR) 


\A “ ( k q V A (R )) 2 ^ i _ k 2 q V 2 {R ) ’ 


where equalities yx T — xy T = [x x y] x and H t [:e]x + 
A[x] x + [Ax\ x = tr(A)[a;] x , for all x,y £ R 3 , have been 
used. Consequently, one obtains 

ip(AR) = e x Ae + yWe = ( r/I — [e] x )We. 

Therefore, 

\MAR)f = e T W(r,I+[e\ x )(riI-[e} x )We 


= e T W{r] 2 I ~[e] 2 x )We 


= e T W (/ - ee r )We 

< (ASr ax ) 2 ||e|| 2 -(ASr i „) 2 ||e|| 4 , 

which yields the fact that ||^(Hf?)|| 2 < (A^" ax ) 2 and also 
||^f?)|| 2 < (A^ ax ) 2 || e || 2 (1 - ||e|| 2 + ||e|| 2 - £ 2 ||e|| 2 ) 


( 51 ) 


'max/ 

<(Arax) 2 ||e|| 2 (l-N| 2 ) + (A^) 2 

<(A^x) 2 /4+(ASl x ) 2 (l-a, 

„2 /-i 2\ 


Hi-a 


where we used the fact that ar(l — x 2 ) < 1/4 for any x £ [01]. 
We just proved (|50|). Consequently, 


W(R T ve q (R))\\ = 


2k q MAR)\\ 


of (251, implies that |fc g VA(-R)| < 1- Therefore the function 
9 q in (22 1 is well defined. Let ( R,q ) £ SO (3) x Q such that 


< 


r(R,qJ = I. This implies that R = 7 Z a (9 q (R),u) r which. 


How- 

one has 


2 k 2 VA(R)u Wu < 4/c 2 (A'/ ax ) < 1/2. Therefore, we must 
have Va{R) = 0 and thus R = I since Va is positive definite 
on 50(3). This shows that r _1 ({/}) = {/} x Q. Using the 
fact that the differentiability interval of arcsin is (—1,1), and 
the fact that \k q VA{R)\ < 1, it is clear, by composition rule, 
that the function 9 q {R) = 2arcsin (k q VA{R)) is differentiable 
on 50(3). The gradient of 9 q (R) is computed using the chain 
rule and is given by 


where © has been used. Now, we prove the following 
inequality 

U(AR)\\ < A^ ax min{l, ^5 - 4£ 2 /2}, (50) 

where £ = A^ n /AjH ax - Let ( 77 , e) £ Q be the quaternion 


yjl -k 2 V 2 (R) 

2A max^ minjl, y/5 - 4£ 2 /2| (52) 

yi -4fcHA g; x )2 

min{l, y/5 — 4£ 2 /2} 1 
y/5 — max{l, 4£ 2 } 2 ’ 

where inequalities ( [50] ) and ( |25j ) have been used along with 
Va(R) < 2A(Hax- Now, making use of the matrix determinant 
lemma det(J + xy T ) = 1 + x T y, for all x,y £ R 3 , one can 
compute the determinant of 0(7?, g) as follows: 

det (0(7?, q)) = det (TZ a (9 q (R), u) T [J+ 

2 mP(R T V9 q (R)) T ]) 
= 1 + 2 u r ip{R T V9 q (R)), 

where lZ a (9 q (R),u) T u = u, det(AB) = det(H)det(i?) and 
det(7?) = 1 for all R £ 50(3) have been used. Since u 
is a unit vector and in view of ( [52] ), it is obvious that the 
term \2u T 'tp(R T 'V9 q (R))\ is strictly less than 1. Therefore 
det (0(7?, q)) / 0 for all R £ 50(3). 

F. Proof of Theorem [2] 

If A (u,v) > 0 is satisfied for all v £ £{A), then 
by Theorem [I] the potential function U = Va (V(R. q) ) is 
synergistic. In order to compute the synergistic gap of U , one 
needs to evaluate the expression in ( |47] >. Making use of the 
following trigonometric identity 


wnt-it- ^ /v min/ /v max* \'h c ) ^ V Lllt/ Ljuait-iun-m . / \ , , / /-— /- ~\ 

representation of the attitude R. In view of ([Sj and identity arcsin(a;) — arcsin(y) = arcsin yxy/l — y — yy 1 — x J , 
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it is clear that, for all R £ SO( 3), one has 


9 pq (R)/2 = e p (R)/2-e q (R)/2 

= axcsm(k p V A {R)) — arcsin(/c,jVA(-R)) 

= arcsin (ji p VA(R)\J 1 — k 2 V^(R)— 

k q V A (R)yfl - k 2 V 2 (R)) . 

Therefore, since k p = k q for p f q, one obtains 

sin 2 (e pq {R)/ 2 ) = 4 k 2 V2(R) (1 - k 2 Vi(R)) 2 . (53) 

At any undesired critical point (f?, q) £ 4 <u \ A, in view of 
€3 and ( |53] l, one has 


6 


min 

(R,q)e*u\A 


U (f?, q) — min U(R 1 p) 
p&Q 


= 2 min 

(R,q)e*u\A 


max sin 2 
p&Q 


(0 P q( R )/ 2 ) A(v,u) 


= 8k 2 V 2 {l - k 2 V 2 )A(v,u), 


where we used the fact that Va{R ) = V at (R,q) £ 'bu \ 
A (see equation (|23j)). By direct differentiation of \21\ with 
respect to A(v,u), one obtains 


da_ 

dA 


8k 2 V 2 
l+4:k 2 AV 


|l - k 2 V 2 + ^ (l + 8 X w k 2 A 

-\/l + 16\ w k 2 A^} . 


Now, using the fact that 1 + x > \Jl + 2x for all x > 0 and 
\kV\ < I/a/ 2, one concludes that da/d A > 0. Also, one can 
verify that 


da 

dW 


16k 2 AV 
l + 4k 2 AV 


(1-2 k 2 V 2 ) > 0. 


Consequently, one has 6 > a ( k , A, A), such that A = 
min A h and A= min A(v.u). 

vGS(A) vGS(A) 


G. Proof of Proposition [2] 

The term A (v,u) depends explicitly on the square of the 
coefficients = u T Vi, coordinates of u in the eigenbasis 
{vi,V 2 ,vz\. Therefore, the maximization ( [30] ) can be per¬ 
formed with respect to a 2 subject to the unit constraint 
a i + a 2 + a 3 = 1- Depending on the spectrum of A and 
excluding the case where A = XI (since no synergistic family 
can be constructed), we have two possible cases. 

1 ) A has two distinct eigenvalues Xf = X 2 7 ^ 

According to ( [48] ), our maximization problem is trans¬ 
formed into finding (1 — A^/A(/) < a 2 < 1 such that 

min A(v, u ) = min {(Af - A^(l - a 2 )) , 

v€£(A) 

((AT-AD(i -«§))}, 

gives a plot of min A (v.u) 

ve£(A) 

with respect to a 3 (green line). It is obvious that the 
maximum (top vertex of the green triangle) is attained at 


is maximized. Figure (2 



Fig. 2 


the intersection A?/ — AJ/(1 —a 2 ) = (AJ/ — A?/)(l — cr 3 ), 

which leads to 


2(Af - A^) 

0\W \W 

za 2 a 3 


= 1 - 


A/' 


2) A has three distinct eigenvalues 0 < A/ < X$ < Xf 
In this case, the maximization problem is formulated as 


max A = max 


mm 
m6{l,2,3) 


A, 


w 


n,Z 


A 14 

mnl uc n / 'l 


subject to a 2 = 1 and A > 0. The above optimization 


i=1 


problem can be formulated as a standard linear program- 

ming problem as follows: 


maximize 

X\ 


subject to 

X 4 + x 2 X™ + x 3 X^ - xY 

< 0 , 


X 4 + x 3 X/^ + xiX^ — XY 

< 0 , 


X 4 + xiX^ + x 2 X^' — XY 

< 0 , 


Xl + x 2 + X 3 

= 1 , 


Xl,X 2 ,X 3 

> 0 , 


X 4 

> 0. 

where the variables Xj = a 2 for j £ { 1 , 2 , 

3}. Conse- 


quently, one can use the simplex algorithm 1301 to solve 
this optimization problem, leading to the following result: 
If the condition 


A/ > 


Ai A 3 

A^-Af 


(55) 


is satisfied, then the optimal solution to the maximization 
in (|54|) is given by 


= 0, 


A/ 


a 3 a 


A A + A^ ’ ' X 2 + A/ 

and the maximum is max A = A/. Otherwise, the 

o - 

a j 

optimal solution is 

a 


= 1-4 


x t 

A j A k 


i £ {1,2,3} 























12 


with the maximum being max A = 4 

a 2 . 

3 

H. Proof of Theorem [J] 

Let us define the following sets: 


n, =1 \ 




Ai 

= {(X, q) £ V x x V q 

Xi = /}, 

A2 

= {( X , q) £ V x x V q 

a 2 = /}, 

Xi 

= {(X, q) £ V x x V q 

{Xi,qi) £ 

A 2 

= {(A, q) £ V x x V q 

{X2, 92) € 4 ' W2 }, 

Ci 

= {(A, q) £ V x x V q 

Pi{Xi,qi) < 5 i} , 

c 2 

= {(A, q) £ V x x V q 

p2{X2, 92) < ^2} • 


Assume that Uh is synergistic with gap exceeding Sh, for h = 
1, 2. Then, in view of one has 

0 < S h < min p h {X hl q h ). 
{X h ,q h )^ Uh \A 

Therefore for each pair (A', q) £ Xh \ Ah, one obtains 
Ph{Xh,qh) > Sh, which implies, in view of the definition 
of the set Ch, that one has 


Ch H X h = Ah 


(56) 


where we used the fact that Ah is entirely contained in Ch- 
Consider the Lyapunov function candidate 


2 


1 


V(X,u,q) = }^Uh{X h ,q h ) + -u 1 Ju. 

h=l 

Since Uh are two potential functions on 5*0(3) x Q with 
respect to {/} x Q and J is positive definite, it follows that 
V is positive definite on Vx x K 3 x V q with respect to A. 


In view of (42 1 , the time derivative of Uh{Xh, qh) along the 
trajectory X h = X h [u h ]x is given by 

Uh(Xh,qh) = 2 V' C r h (X h ,q h ) T XV Ah (T h (X h ,q h ))) T 

@h(X h , qh)uh 

= 2^ (A h T h (X h , qh)) T Oh(X h , qh)^h, 

(57) 

where we used VVa(-R) = RP a {AR) for all R £ SO{ 3). 
Therefore, making use of the above result and f35) l, the change 
in V along the continuous flows of C is given by 

2 

V(X ,u,q) = 2Y J Uh®h(X h ,q h ) T il>{A h Th{X h ,qh))+ 

h =1 

0J T ^[Jw] x w - 2 Y h ®h(X h , q h ) T il>{AhT h (X h , q h )^j 
= -2||0 1 (A 1 ,g 1 ) T ^(A 1 r 1 (A 1 ,g 1 ))|| 2 < 0. 


Thus V is non-increasing along the flows of (35 1 . Moreover, 
for any (X,q) £ D and s £ g{ A), one has 

2 

V(A ,ho,q)-V(X,o J ,s) = Y, 


h =1 

2 


U h {X hl q h ) - min U h (X h ,p) 

peQ 


— 'y Ph {Xh, qh) 


h— 1 


> min{<5i, 5 2 } > 0, 


which shows that V is strictly decreasing over the jumps of 
(35 l. Using [ED, Theorem 7.6], it follows that A is stable. 
Moreover, applying the invariance principle for hybrid systems 
given in [ED, Theorem 4.7], one can conclude that any 
solution must converge to the largest invariant set contained 


X= {(A ,u,q) £ V x XI 3 XD,: (A ,q) £ C, 

0i(Ai, gi) T ^>(AiTi(Ai, gi)) = 0} . 

It follows, in view of ( |57| >, that for all (A ,u),q) £ T, one has 
(Ai,gi) £ 'lT/ 1 . Consequently, the set X can be rewritten as 

X= {(A ,u,q) £ V x x R 3 x V q : (A, q) £ C D X ± } . 

Moreover, from ([56]), one has G) H Aj = Ai and hence C (T 
Xi = {Ci D C 2 ) (~l Xi = C 2 HA 1 , where we used the fact that 
C = C\ fl G 2 . Since the solutions converge to C 2 D A\ , it is 
clear that Ai —> I which leads to Ai —) 0. Hence, one can 
conclude from ( |35j ) that u —> 0. Since uj = 0, it follows from 
( |32| ) that r must converge to 0. Using this last fact, together 
with the fact that B = 0, one can conclude from ( |34| that 

02 (A 2 , ^2) T "0(^21^2 (A 2 ,^ 2 )) = 0. 


Again using (57 1 , one has {X 2 ,q 2 ) £ "L u 2 . Therefore, the 
solutions must converge to C 2 (1 Ai (1 X 2 = Ai H A 2 = A, 
where the fact that C 2 (T X 2 = A-j has been used. Finally, the 
set A is globally attractive and stable which shows that A is 
globally asymptotically stable. 


I. Proof of Proposition [j] 

Let us define the attitude error P := RP T , for some P £ 
50(3). For h £ {1,2}, making use of the identity u T Au = 
tr {uu 1 A), one obtains 

n 1 n 

2 E PihWbi - P T ^\\ 2 = 2 E (I - P T )(I - P)n 

i= 1 i=l 

n 

= E Pih^inrJ {I — P)) = V Ah {P ). 

i= 1 

Consequently, equation ( [36] ), respectively ( [38] ), is obtained by 
substituting P for Y h , respectively P for Tlf{ 6 h q {Xh), Uh)Yh- 
Furthermore, one has 

1 " 

I ^a{AhP) = — y ] Pih 
i —1 
1 " 

= g E P^ P [ pTr ^ R ~ RT ^ r J P } pT (58) 

^ 1=1 

1 n 

= 2 E Plh i P ( bi x pT o)] x . 

Z i=1 

where we used the following property (see EH): 

R[yx T - xy T ]R T = R[x x y] x R r = [R(x x y)] x . 

Taking the vex operator on both sides of ( |58| ) and substituting 
P for Y h , respectively P for IZj{0 hq (X h ), u h )Y h , yields 
equation ([37]), respectively equation ( |39| . 


P~ P 


lT r,r7 
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VI. Simulation results 

In this section we illustrate the procedure to follow for 
the implementation of the hybrid scheme derived in Section 
m We, then, compare between the smooth feedback law, 
proposed in 120) . and the hybrid feedback of Section [TV] Let 
Q = {1, 2} and let the scalars k^i = —kh 2 = kh, for h = 1,2 
where kh has a specific value to be tuned later. Let also 
A\ = diag([l, 3, 5]) and A 2 = diag([0.1, 0.3, 0.5]). The value 
of kh is chosen to verify inequality ( |25] l. We picked k\ = 0.03 
and k 2 = 0.3. Moreover, with this choice of matrices A t 
and A 2 , one can see that condition m is verified for both 
matrices. Therefore, the optimal choice of the rotation vectors 
u\ and u 2 is given by 

uj = [ 0, x/3/8, x/5/8], uj = [0,y/3/8,^5/8]. 



Fig. 3: Error between the current state and the desired 
reference for different initial conditions close to the 
undesired equilibria ei)-Smooth controller- 


The maximum values of the hysteresis gaps <5i and S 2 can 
be computed, using the result of Theorem [2] Therefore, it is 
sufficient to pick = 0.5 < and S 2 = 0.05 < S 2 to 
implement the switching conditions of the set C and the set 
D. Once all the parameters have been designed, the hybrid 
controller (34 1 can be implemented. We recall the following 
smooth feedback law proposed in the paper 


2 n 

r = xY^n), 

h—1i —1 
n 

@ x Y \ r i)- 

i =1 


(59) 


Both controllers, hybrid and smooth, were implemented in 
Simulink. The desired rotation as well as the initial condition 
R( 0) for the auxiliary system were both chosen equal to the 
identity matrix, i.e., R,i = R( 0) = / 3X 3 . The inertia matrix 
has been taken as J = diag ([1,1,2]) and the inertial vectors 
as r, = e,, for i = 1,2,3. The performance of the controllers 
was evaluated by means of the nonnilized erroj^] 

e(X h ) := X h \\ F . 


To simulate the worst case for the smooth controller, the 
initial conditions for the rotational dynamics are taken as 
follows: w(0) = [0, 0, 0] T and i?(0) = !Z a (ft + L cos(e/2)ei) 
for some e <C 1. Thus, under the smooth feedback ( |59) , the 
closed-loop system starts sufficiently close to the undesired 
equilibria X\ = X 2 = 1Z(i r, ei). Figure [3] shows the evolution 
of the error e(X 2 ) with respect to time. At early times, 
the convergence is slower for closer initial conditions to the 
undesired equilibria (smaller choice of e). This phenomenon 
is the main drawback of the smooth controller. On the other 
hand, for e = 0, Figure [4] depicts how the hybrid controller 
reacts immediately to correct its offset rotation, whereas the 
smooth controller does not react at all, being seemingly unable 
to correct its rotation. 

3 This error can be shown to be equal to e(Xh) = ||eh||a where ej, is the 
quaternion vector part corresponding to the orientation described by E 
50(3). 



Fig. 4: Comparison between smooth and hybrid feedback 
responses with the initial condition X 2 ( 0 ) = 7l a (n : ei) 


- 9i 

- 92 


0 2 4 6 8 10 12 14 16 18 20 



Fig. 5: Comparison between smooth and hybrid feedback 
responses with the initial condition 

* 2 (0) = , e\)R a (t?i,Mi) T . 


For a second comparison, we changed the initial rotation 
matrix to 

R{ 0) = R a { 7T, ei )H a (‘dl,U 1 ) T , 


where = 2 arcsin 


-1 + \Jl + 16A^ 1 (fcn) 2 A(ui,tti) 
4fcnA(ui,iti) 


thus ~ 0.47, so as to start from one of the critical points 
of the potential function U±(Xi,qi) (see equation (|24|)). 
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Time 


Fig. 6: Plot of the torque applied by the hybrid feedback 
with the initial condition ^(0) = TZ a {^, ei). 

Figure [5] depicts the performance of the proposed hybrid 
feedback law. Starting from an initial configuration q{ 0) = 

(1.1) , the system immediately jumps to the configuration q = 

(2.2) since the initial condition (X(0), g(0)) lies inside the 
jump set D. It is shown in Figure [5] that the hybrid controller 
still achieves better performance than the continuous controller 
for this particular initial condition. 

In Figure [6j we give the plot of the torque (control input) 
applied by the hybrid controller in the first case of A^fO) = 
TZa(^, ei). We observe that the torque is “quasi-smooth” with 
only three discontinuities which occur during the first few 
seconds of the control in order to avoid the critical points. 
The second jump (red) affects only the second component of 
the torque vector. 

VII. Conclusion 

Synergistic potential functions are instrumental in the design 
of hybrid control systems on SO(3) that achieve global 
asymptotic stability results. This paper presented a systematic 
approach to generate synergistic potential functions on SO(3) 
via angular warping. By introducing a new warping angle 
function, the synergistic gap-necessary for the implementation 
of the hybrid controller- was explicitly computed. The feasi¬ 
bility of the synergism conditions and the maximization of the 
synergy gap are discussed. We also proposed a hybrid attitude 
stabilization control scheme without velocity measurements 
relying only on inertial vector measurements. The proposed 
control scheme leads to global asymptotic stability results. We 
presented some simulation results that illustrate the advantage 
of the hybrid control scheme over the standard continuous 
feedback strategies. 
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